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ABSTRACT 


The feedback control and modeling of a mobile robot with two wheels that are 
independently steerable and drivable is studied. Two-wheel steer vehicles increase their 
maneuverability when both wheels are drivable and therefore increases their performance 
in confined spaces. A dynamic feedback control algorithm is developed, which enables 
the vehicle to move from any initial configuration (position and orientation) to any final 
configuration. Simulation results are presented to verify the independent control of the 
two position variables and the orientation variable. A comparison with a two-wheel 
steering and one wheel drive vehicle shows that driving both wheels increases 


performance and maneuverability. 
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I. INTRODUCTION 


Wheeled mobile robots come in a number of different kinematic structures. 
Typical robots have a steerable front wheel(s), and the rear wheel(s) whose orientation 
relative to the vehicle body is fixed, such as an automobile or a bicycle. Some robots are 
the differential-drive type which have two co-axial wheels that are independently actuated 
to achieve forward/backward and rotational motions. The synchronous-drive type of 
mobile robots such as Nomad 200 [Ref. 1] have all the wheels steer and rotate together so 
that the wheels are parallel all the time. Mobile robots such as these have two degrees of 
freedom and are nonholonomically constrained. 

This thesis describes a type of mobile robot that has two independently steerable 
and drivable wheels. Using the bicycle as an example, this type of mobile robot would 
have both the front and rear wheels drivable as well as steerable. It has been shown that a 
mobile vehicle with two steerable wheels with one drivable can be controlled using 
dynamic feedback control [Ref. 2]. One example of this type of mobile robot is the SR2 
mobile robot from Cybermotion Inc. which has three steerable and drivable wheels [Ref. 
3]. Four-wheel steering automobiles [Ref. 4 and Ref. 5] and fire trucks [Ref. 6] are other 
examples, both of which are designed for improving maneuverability. Although these 
types of vehicles are still nonholonomically constrained, they can still be controlled to 
follow a path with independent orientation [Ref. 7] and are extremely maneuverable in 
confined space [Ref. 8]. 

This thesis focuses on modeling and control of a vehicle with two wheels, both of 
which are steerable and drivable. The vehicle has four input variables, the steering 
velocities of the two wheels and the rotational velocity of both wheels. The problem of 
how to steer and deliver the torque to the two wheels in order to independently control the 
position and orientation of the vehicle body is studied. In particular, a dynamic feedback 
algorithm is developed, which linearizes and decouples the system. The output in this 


case is the two-dimensional position and one-dimensional orientation of the vehicle body. 


Consequently, the algorithm enables the vehicle to follow any desired position trajectory 
and orientation trajectory. Furthermore, it will be shown that the input-output 
linearization cannot be achieved by any static state feedback [Ref. 2]. Dynamic feedback 
linearization was previously applied to three-wheel mobile robots (with a free or steering 
wheel) that have only two inputs [Ref. 9]. 

One of the benefits of having both wheels drivable would include increasing the 
maneuverability the vehicle. Both wheels drivable would allow pure rotation in place and 
pure translation in the lateral direction of the vehicle. Imagine parallel parking by just 
rotating all wheels perpendicular to the body of the vehicle and laterally translating into 
the parking space. Another benefit would be the ability to have the torque distributed to 
the wheels depending on the road conditions, and if a wheel began to slip, the torque 
delivered to the wheels could be transferred to the other wheel. This would result in a 


two wheel steerable, one wheel drivable vehicle until the slipping wheel regains traction. 


Il. KINEMATIC MODEL OF THE VEHICLE 


A. NOTATIONS 


Figure | shows a diagram of a vehicle with two independent steering wheels. The 
two wheels are located at p; and p2 on the vehicle, respectively. po is located at the center 
of gravity of the vehicle which is assumed to be located on the p; - p2 axis. The distance 
from po to p; is a and the distance from po to pz is b. 

Four coordinate frames are defined for describing position and orientation of the 
vehicle [Ref. 2]. {U} is the earth-fixed coordinate frame. {1} 1s the frame fixed on 
wheel 1. x; 1s chosen to be along the horizontal radial direction and y; is in the lateral 
direction. Likewise, {2} is the frame defined for wheel 2. {0} is the frame defined at 
point po. yo is chosen to be a unit vector pointing from p2 to py, and Xo 1s orthogonal to 
the line segment from p> to py. 

The orientation of the vehicle body is characterized by 49, which is the angle from 


Xu to Xo. o; and o2 are two steering angles defined from Xo to xj, 1 = 1,2. With these 





Figure 1: Coordinate systems for a two steering wheel vehicle 


notations, we are ready to establish homogeneous transformations describing one frame 
relative to another. In what follows, “,T denotes the homogeneous transformation of 
frame {b} relative to frame {a}. Because the motion of the vehicle is restricted to the 
two-dimensional plane, homogeneous transformations are 3 x 3 rather than 4 x 4. 


cos(dy) —sin(dy) Xo 
=| Sin(Gapeecas (OG) 


0 0 | 
cos(d,) —sin(o,) O 
{hs sin(d,) cos(o,) a 
0 0 1 
cos(d,) —sin(o,) 0 

ST =| sin(d,) cos(d,) —b 
0 0 l 


B. VELOCITY KINEMATICS 


With the help of homogeneous transformations given above, the velocities of 


point p; and point pz can be computed. The homogeneous position vector of point p; and 


p2 expressed in frame {0} are: 


0 0 
* Py sa se: 
| l 


—— 
Pigg ee 


These points are represented in frame {U} by 


COS(My) —SIN(OH) Xp — ASIN(Qo) + Xp 


0 
i oe SINn(My)) COS(d_) Yo | @/=] acos(dy) + Vo 
l 


0 0 | l 
COS(Oy) —sSiN(d)) Xp | O bsin(dg) + Xo 
A Daal bs =| sin(Q)) COS(d9) Yo l —b|=|—bcos(d,) + yo 
0 0 l l l 


The velocity of the points p; and p> (or differentiated with respect to frame {U}) 


expressed in frame {U} are: 


~ acos(y)bo + Xp bcos(dy) 4 + Xo 
” p, =| —asin(dy)by + Yo ” Py =| bsin( gy by + Yo 
¢ Q 


In order to derive the nonholonomic constraint equations of wheel |, the velocity 


of point p; relative to frame {U} is expressed in frame {1}: 


- . COS(D_ a 0,) sin(Q, A 0,) ss 
1b =(4T) “p, =(47S7) "a, =|-sin(d +0,) cos() +0,) *|” p, = 
0 QO | 


Xo COS(My + O,) + Yq Sin(, +,) — ad, COS(d, ) 
— Xq SIN(D_ + O,) + Vo COS(Oy + O,) + ad, sin(O, ) 
0 
where the terms indicated by * are irrelevant in the computation. Likewise, the velocity 
of point 2 relative to frame {U} is expressed in frame {2} as follows: 
X 9 COS(g + 2) + Ho SIN(Hy +3) +b COS(,) 


Py =| — Xp Sin(%g + 05) + Vy COS(y +05) — bd, sin(d, ) 
0 
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Cc: CONSTRAINT EQUATIONS 
The vehicle is subjected to four nonholonomic constraints. The first two 
constraints are derived from the fact that the wheels cannot move in the lateral direction. 
That is, the y component of De and ah is Zero: 
— Xp Sin(dy + 0,) + Vp COS(by +,) +. ab, sin(o,) = 0 
— X9 Sin(dy) +5) + Yo COS(by +5) — bo, sin(o,) = 0 
The other two constraints are due to the no-slip condition. Let r be the radius of 


the wheels, and @;, i=1,2 be the angular displacement of the wheels (driving angles) then 


the x component of 'p, and 7p, is equal to the velocity of the wheel in that direction. 
These two constraints are expressed as: 
Xp COS(y +O,) + Vo SIN(Oy + ,) — ab, cos(,) = 70, 
Xp COS(Hy +05) + Vo SIN() + Oy) +b, cos(o,) = 0 
Choosing the following generalized coordinate vector 
a=[xo yo 0: & % 
the four constraints can be written as 
A(q)q = 0 (1) 
where the 4 x 7 dimensional matrix A(q) is given by 
= sin(, ++ ,) cos(, =F o,) CO 0a sin(6, ) 
A(q) a ~ sin(, +5) cos(, +5) O O — bsin(o, ) 


EN e an mi aeee 
cos(o + 3) sin(, aa O -r beos(, ) 


eS 2. oc 
= 2) 2 © 


D. KINEMATIC MODEL 


The 4 x 7 dimensional matrix A(q) has a 3-dimensional null space. Let 


S(q) ={s,(q) s,(q) s3(q)| 


be a 7 x 3 full-rank matrix whose columns s;(q), i=|,2,3, are in the null space of A(q), that 
is, A(q) si\(q) = 0. The three columns of S(q) form a basis for the null space of A(q). 
Since the generalized velocity g is always in the null space of A(q) as characterized by 


Equation (1), 1t may be expressed as 


g = S(q)n (2) 
where 7 is a 3-dimensional vector of independent velocities. It is noted that the choice of 
S(q) and the corresponding 7 is not unique. For a certain choice, 7 may not necessarily 
represent any physical velocity. 

As stated earlier, both wheels are steerable and powered. However, only three 


velocity inputs are needed. If we choose 7 to be the three angular input velocities, that is, 


6 


us 8, 
N=|N2 |=] > (3) 
3 b> 
the corresponding S(q) is then given by 


o-oo @ CO 2 €& 
—— One 2 Oc ¢ 


where 


COSMO, SIN(O, —, , 


51,(q¢) = feos 2 UW ASG 


sind, sin(d, — 0, , 


S91(q) = sin oD ie 2 sind, 


sind, 
sin, 
r  sin(d, —,) 


Sid) salem 


54, (q) = 


E. DYNAMICS 


Since only one wheel rotation velocity is used as one of the inputs, the torque 
delivered to both wheels must be incorporated into this single input. This relationship is 
obtained by solving the dynamic equation for the forces. Figure 2 shows the dynamic 
forces acting on the body and wheel unit. Summing the moments about the Zo axis at the 


center of gravity yields 
S M,, =—aF, cos, + bF, cosh, = Lon (4) 
where Ig is the body moment of inertia. For the wheel, summing the moments at the 
point where wheel 1, (1 = 1,2) makes contact with the surface yields 
»? M,=ck, +7; = Iy9, + rmya, 
where Iw is the wheel moment of inertia and mw is the mass of the wheel. Since the 


acceleration a, =1r0., 


i 


Dt eo, (ly +r7my ) 


Oe (5) 


C 
Combining Equation (4) and Equation (5) provide the governing equation of motion. 
at, cosh, — bt, cosh, —aly8, cosd, +bi,8, cosh, =cl pV (6) 
where Jy =Iy +r°my. 
From Figure 3, the following relationships can be derived. The velocity diagram 


and the law of sine’s provide the following relationship between 0, and @,. 





Figure 2: Dynamic force diagram 


sing, sind,  sin(o, —,) 


i L  atb 
j VV, r@,sin(d,-,) _r8, sin(9, -6,) ; 
"£ -£,  sino,(a+b)  _ sin, (a +b) ue 
0, sind, =9, sing, (8) 





Figure 3: Kinematic velocity diagram 


Differentiating Equation (7) and Equation (8) and making substitutions and 


solving for 8, provide 


= 9 
: rsingd, sin(o, =, ) Si 


Likewise, solving for 0, 


a (a+b)sing, sin(6, ~6,) 


Combining Equation (6), Equation (9), and Equation (10) gives the equation for 


(10) 


the angular acceleration of wheel | as a function of both wheels input torque and the 


angular velocity of the body. 


6,rsin(o, = 6, aly (a +b)cos, sind, —bly(a+b)sino, cos, — cl gr sin(o, - ,)| - 
t, |ar(a + b) cos, sing, sin(o, - ,)] =i lbr(a + b)coso, sind, sin(o, — 1) 


bly (a+b)? cosh, |. sind, cos, — , cosd, sind, | 


ee (11) 
le cI pra +b)|sin 5 cos(, = 6, \(6, —$,)- 2 COSO, sin(>, a 6) 


+4 


Equation (11) can be integrated to provide the angular velocity of wheel | for the 
input to the control algorithm. In this way, both torque inputs are combined into a single 
input necessary for use as one of the three inputs for the control algorithm. The other two 
inputs will be the two steering angular velocities. 

The next chapter develops the control for the vehicle and uses these three 
velocities as the inputs for the feedback control algorithm. From these three inputs to the 
control algorithm, the seven dimensional state vector provides the outputs of the vehicle’s 


position and orientation. 


Il. FEEDBACK CONTROL 


Considering the generalized coordinate vector q as the state vector, the kinematic 
model of the vehicle represented in the state space form is characterized by Equation (2) 
in which 7 is the input to the system. To control the position and orientation of the 
vehicle, the natural choice for the output equation is: 
Xo 
y=h(q) =| yo 
Po 
Once the state equation and output equation are derived, the next step is to design 
a controller for this system. Feedback linearization technique is used [Ref. 10]. It has 
been shown that a static feedback 1s not capable of linearizing the system [Ref. 2] which 
will be repeated here. Furthermore, the dynamic feedback that linearizes and decouples 


the system will also be derived. 


A. STATIC FEEDBACK 


To derive a static nonlinear feedback, we differentiate the output equation. 


an(q) a 
y= SP g = SP seq = (gn 
q Og 


where ®(q) denotes the decoupling matrix of the system. If @(q) is of full rank, we may 
apply a static feedback of the form 
n=O" (qe 
to obtain the linearized closed-loop system: 
you 
In the present case, the decoupling matrix 1s given by 


5,(q) 90 O 

0] 1] 
(q) = SE sia) = Sy(q) 90 O 
55(q) O O 


which is unfortunately singular. Therefore, it 1s not possible to have a static feedback that 


linearizes the system. 


B. DYNAMIC FEEDBACK 


If a system is not linearizable by any static feedback, it may nevertheless be 
linearizable by a dynamic feedback. The construction of a dynamic feedback consists of 


two steps. First we construct a static feedback shown below, which 1s called Feedback I: 


Seu (Gann 
TN= 0 1 Of 
0 0 1 


The application of this feedback results in the following closed-loop system: 


y=, 


[ee = eae” 
y3 551/51) P51 (09,91,92) 


It is noted that the first component of the output is linearized and decoupled from 
the other two components. Next, we apply another feedback in order to linearize the 


latter two components of the output. To do so, we differentiate them once more. 


oY, Oo, ay 
| tee AD, |. do, 6, | >, 
Sle le fem ay Po TM av, aa | 6, 

0 db, ab, 


Noting that $9 = 55:11, = 55,/5,; 1, and 


0» 3 Ls 
we may represent the above equation as follows: 


ie = O,(q)U, + Q, (q)L; T ag) 
v3 Ls 


where 
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iq = O)(q)p, +Q; (q)ey + ao)" 
y3 3 








where 
Pi 
oa) =| 9" | 
OV, 
Oo 
O(q) = Ov, $5) /S\ 
00 9 
Ov, OF; 
_ Oo, ob, 
Q(g) = py, OY,, dF,, 
Oo, 0b, 


Now applying Feedback II given by 


li =o" oll” | -O71(g)h, - Q, oni) 


3 


vie VA 


The complete controller with three feedback loops for the steering angles and the 


the latter two outputs are linearized as 


lI 
(- ae 


Furthermore, let 1, = v,, therefore 


wheel velocity input is depicted in a block diagram in Figure 4. Figure 5 shows the 
MATLAB Simulink program diagram. 

The simulation results are provided in the next chapter. The results showed a 
significant improvement in performance over the two-wheel steerable, one-wheel 


drivable vehicle. 


13 







Feedback I [7 


Figure 4: Dynamic feedback controller 
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Figure 5: MATLAB Simulink program 
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IV. SIMULATION 


A. TEST CONDITIONS 


The vehicle feedback control system shown in Figure 4 has been simulated using 
Matlab Simulink (Figure 5). Each block in the figure is implemented by the use of an S- 
function [Ref. 11]. To stabilize each of the linearized subsystems, the linear feedback is 
further designed. In the simulation, the linear feedback gain is chosen to place the poles 
of each subsystem at -5 and -15. The system was tested and compared to the performance 
of the dynamic control algorithm for the two steering, one wheel drivable vehicle. The 


following are the initial and goal configurations used for the test: 


Xo 0 Xo 10 
Yo =| 0 Yo =|| —5 
%o init 50" %o goal — 10° 


The parameters used for the simulation are designed to be realistic of an actual 
robot and in MKS units and are as follows: 
a= Woe) b = 0.30 e— 025 
r=0.10 i= 20 i= 005 
Figure 6 clearly shows that the path from the initial point to the goal is a straight 


line. This direct path was the result for the two steering wheel vehicle regardless if one or 


both wheels were powered. 
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Xu 


Figure 6: X-Y plot 
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B. INDEPENDENT CONTROL OF POSITION AND ORIENTATION 


Figure 7 through Figure 14 show the response of the two wheel drivable vehicle 
compared to the one wheel drivable vehicle for the same initial and final conditions used 
in the test. It is evident from Figure 7 to Figure 14 that in either case, both the position 
and orientation converge to the goal. This confirms that the position and orientation can 
be independently controlled. However the manner in which they reach the goal differ 
significantly. 

The vehicle with only one of the wheels drivable quickly accelerates and rotates 
early in the trajectory and then slowly approaches the goal. The vehicle with both wheels 
drivable has a steady velocity and rotation throughout the trajectory. This is especially 
evident in Figure 11 and Figure 12. The body angle versus time clearly show the 
differences between the two simulations, even though both trajectories follow a direct 
path to the goal. 

Both the constant rate of speed and constant rate of rotation of the body would be 
highly beneficial if there were on board sensors scanning the environment during the 


journey. 
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X and X dot 





time (sec) 


Figure 7: Two wheel drivable vehicle (X: dashed, X dot: solid) 
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Figure 8: One wheel drivable vehicle, Xu versus time 
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Y and Y dot 
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Figure 9: Two wheel drivable vehicle (Y: dashed, Y dot: solid) 
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Figure 10: One wheel drivable vehicle, Yu versus time 
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Figure 11: Two wheel drivable vehicle (phi: dashed, phi dot: solid) 
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Figure 12: One wheel drivable vehicle (phi: dashed, phi dot: solid) 
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phi 1 and phi 2 (degrees) 
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Figure 13: Two wheel drivable vehicle (phi 1: dashed, phi 2: solid) 
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Figure 14: One wheel drivable vehicle (phi 1: dashed, phi 2: solid) 
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c: ONE WHEEL VERSUS TWO WHEEL DRIVABLE VEHICLES 


Figure 15 and Figure 16 emphasize the differences between the one wheel 
drivable and two wheel drivable simulations. Even though both cases have two wheel 
steering, when both wheels are drivable, the transition from the initial starting point to the 
final goal point is much more linear than when only one wheel is powered. The body 
angle was adjusted by 90 degrees to the longitudinal axis of the vehicle, so that its 
Orientation is from a more familiar perspective. 

In Figures 15 and 16, each frame of the vehicle represents the vehicle’s position, 
wheel angle, and the vehicles orientation at a particular point in time. Each snapshot is 
taken at equal intervals of time. These two figures clearly show that when only one wheel 
is being drivable it must approach the final goal point slowly to align to the correct 
orientation. When both wheels are drivable, the rotation of the vehicle is consistent 


throughout the trajectory. 


Jig 








Yu 





Figure 15: Two wheel drivable vehicle trajectory 
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V. CONCLUSION AND FUTURE WORK 


This thesis studied the control of a two-wheel vehicle with both wheels steerable 
and drivable. Unlike one-wheel steer mobile robots (e.g., the automobile/bicycle/tricycle 
type of mobile robots), the control of two-wheel steer robots are less intuitive and more 
difficult. By making both wheels drivable the complexity of the control algorithm 
increases further. Using a dynamic nonlinear feedback, independent control of the 
position and orientation of a mobile robot was obtained. The orientation is no longer an 
uncontrollable state variable governed by internal dynamics. Consequently, while the 
vehicle follows a direct path to its goal, its orientation does not have to be in the 
tangential direction of the path. For example, the orientation of the vehicle body can be 
independently controlled for scanning with onboard sensors. 

Further work on this project includes: 

The concept developed in this thesis can be extended to an all-wheel steering, all 
wheel drivable vehicle with four independent wheels. This may require redefining the 
constraint equations as well as the kinematic force and velocity equations may be 
required. 

Distribution of the torque between the wheels would be greatly beneficial if one 
of the wheels began to slip. This simulation used a constant torque value for each wheel 
initially, but later trials found that a constant torque divided by the angular speed of the 
wheel squared provided the best overall performance. More research is needed on how 
exactly to distribute the torque to each wheel depending on the steering angle, final and 
initial position and configuration, and surface conditions. 

It was stated from Equation (3) that the input velocities, n, were chosen 
arbitrarily. Perhaps better performance could be obtained from using the two angular 
wheel velocities and one steering angular velocity for the input parameters. These new 
inputs would make each input torque independent of the other, allowing one of the 


wheels to slip. 
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